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ABSTRACT 

The  extended  Kalman  Filter  (EKF),  in  the  continuous  time  version, 
has  to  be  Interpreted  in  the  Ito  sense.  Therefore,  processing  of  the 
(EKF)  algorithm  is  much  more  involved  than  has  appeared  to  be  the  case. 
An  additional  - — differential  equations  have  to  be  processed 
when  the  EKF  is  properly  Interpreted. 


PRESENTATION 


Consider  the  continuous  nonlinear  stochastic  dynamic 
system  and  observations  given  by 


dx(t)  *  f{x(t),t)  dt  +  G(t)  dw(t) ,  x(t  )  *=  X  (1) 

O  O 


And 

dz(t)  =  h(x(t),  t)  dt  +  dv(t) 

Where 

x(t)  e  Rn  is  an  'n'  dimensional  state  vector. 
f(x(t),t)  is  an  *n*  dimensional  vector  valued 

Am 

function. 


(2) 


x,e  Rn  is  an  'n*  dimensional  Gaussian  random 
o 

vector  with  mean  x  .  and  covariance  P  - 

o 


J(t)  «  Rm  is  an  ’m*  dimensional  observations  vector. 

h(x(t),t)  is  an  ’m*  dimensional  vector  valued 
function. 


w  (t)  e Rn  is  an  *n'  dimensional  Wiener  process  with 
zero  mean  and  covariance  Q(t) . 

v (t)  eRn  is  an  'n'  dimensional  Wiener  process  with 
zero  mean  and  covariance  R(t) . 
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Under  the  assumption  that  xQ,  w  (t) ,  and  v  (t)  are  mutually 
independent  of  each  other,  and  R(t)  considered  to  be  positive 
definite  matrix,  the  widely  used  Extended  Kalman  Filter  (EKF) 
is  given  by  the;  following- set  of  equations  Cl3 

dx(t)  -  f(x(t),t)  dt  +  P(t)  HT(x(t),t)R“l(t)  fdjtt)  - 
~  ~  ~  ~  L 

h(i(t),t)  at]  ,  x(t0)  -  ^ 


d_  P(t)  *  F(x(t),t)  P(tl  +  PCt)FT(xCt)  ,t)  *  G(t)Q(t)G  (t) 
dt 

-  P(t)  HT<x(t),t)  R”1  ( t)  H  (x  ( t)  ,  t) P ( t)  , 


PCt  )  *  P 
o  o 


Where 


-  a  r  ah»  (xtt) ,t) 

H(x(t),t)  =  - — - 


3  Xj  (t)  lx(t) 


.  1 

X  ( t)  J 


.  .  3f  (x(t)  ,  t) 

<x(t),t)  ^  ^ - 

L3xj  (t)  £ 


(t)=x(t) 


It  is  clear  that  th*  matrices  H(x(t)  ,t)  and  F(x(t),t)  as  given 
by  equations  (5)  and  (6)  are  state  estimate  dependent. 

Hence,  also  the  covariance  matrix  is  state  estimate  dependent, 
and  a  more  accurate  description  of  the  (EKF)  is  as  follows: 

dx(t)-f  (x(t)  ,t)dt+K(x(t)  ,t)  £dz(t)-h(x(t)  ,t)dtj  , 

A 

x  ( t  )  ->L 
—  O  *'0 


j^P(x(t)  ,t)«F(X<t)  ,  t)  P  (x  ( t)  ,t)+P(x(t)  ,t)FT(x(t)  ,t)  + 
G(t)Q(t)G  T(t)- 

P(x(t)  »t)HT(x(t)  ,  t)  ( t)  H  (x  (t)  ,t)P(x(t)  t)  ,P(t  _)-Pft  (8) 
Where 

K(x(t)  ,t)*P(x(t)  ,t)HT(x(t)  ,t)R"1{t)  is  the  filter's 
^  * 

gain  matrix. 

Now,  it  is  easy  to  recognize  that  equation  (7)  is  an 
Ito  stochastic  differential  equation.  Hence,  it  should 

A 

be  integrated  in  the  Ito  sense.  Therefore,  whenever  numerical 
simulations  of  the  (EKF)  are  carried  out,  equation  (7)  has  to 
be  transformed  into  an  equivalent  differential  equation  in  an 
ordinary  sense  such  as  the  Stratonovich  sense.  The  Stratonovich 
equivalent  of  (7)  is  obtained  by  modifying  the  i—  component 


fi(x(t),t)  by  the  following  quantity 


n  m 


-*  L  Ei  (* 


BK, 


K.4  <x(t),t>  — iii&iil 


1  xt(t) 


Therefore,  for  the  completeness  of  the  EKF,  the  expression 

dKj 


for  all  i,  j,  and  l 


3  xt(t) 


has  to  be  included.  Denote  — A  ^  by 

a  xi(t) 
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A 

X*  <x(t),t),  and  8-  p(g(t)  ft)  by  P‘  (x(t)  ,t)  ,  then 

Xj  ~  .  *  i 

1  3x 


KX.  (x(t)  ,t)»  [  P(x(t)  ,t)  aH.  (S(  + 

i  8xi 


£±>  HT(x(t)  ,t)  ]  R-1(t) 

3Xi 


(9) 


And  for  P*  (x(t) ,t) ,  assuming  that  P(x(t),t) 
i 


is  continuous  in  both  arguments,  we  have 


Pv  (x(t)  ,t)=F<x(t)  ,t)P*  (x(t),t)+F;  (x(t)  ,t)  P(x(t)  ,t)  + 

at  x^  ~ 


Pc  (x(t)  ,t)FT(x(t)  ,t)+P(x(t)  ,t)Ft  (x(t),t) 
^  ^  ^  ^ 


-  P-  (x(t),ty  HT  (x(t)  ,t)R_1(t)H(x(t)  ,t)P(x(t)  ,t) 
i  ~ 


-  P(x(t)  ,t)  H?  (x ( t)  , t)  R_1(t)H(x(t)  ,t)P(x(t)  ,t) 

^  A  •  ^  ^ 


-  P(x(t)  ,t)HT(x(t)  ,t)  R~  it)  H*  (x ( t)  , t)  P(x(t),t), 

^  X  j 


-  P(x(t),t)  HT(x(t),t)  R_1(t)  H (x( t)  ,t)  Pj  (x(t),t). 


Pxi  <V  "  0 


(10) 


for  every  i  *  1,  2,  . ,n 

where 

(iui.t).8  gjg'VfV  i  JL 


3ht(x(t)  ,t) 

.  1 

•«* 

x(t)»x(t)  J 
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[  a2h1(x(t),t) 

■ 

L  s*i  8xj 

x  (t)  *x(t) 

(11) 


and 


(x(t) , t)  = 


3F(x(t),t)  A  a 

3ft(x(t) ,t) 

a^ 

.  8XJ 

x(t)=x(t) 

a2f £  (x(t) ,t) 

a  x^  3Xj 

X  ( t )  —X  ( t) 

*+*  *+*  m 

(12) 


Conclusion; 

a 

The  continuous  time  EKF  has  to  be  interpreted  in  the  Ito 
sense.  Therefore,  the  actual  computational  requirement 

for  implementing  the  EKF  is  increased.  An  extra  n  matrix 

a 

differential  equations  for  P*  (x(t) ,t)  ,  i=l,2,...n  are 

xi 

coupled  to  the  differential  matrix  Ricatti  equation  for 

A 

P(x(t),t).  Also,  the  nonlinearities  f(x(t),t)  and  h  (x(t),t) 
are  assumed  to  have  mixed  second  order  partial  derivatives 
with  respect  to  the  components  of  x(t) .  Of  course,  if  an 

A 

integration  routine  that  conforms  with  the  Ito  definition  of 
stochastic  integral  is  used  in  processing  the  (EKF)  algorithm, 
then  it  is  sufficient  to  process  equations  (7)  and  (8). 

Among  the  widely  used  integration  routines,  the  rectangular 

a 

routine  is  the  only  one  that  conforms  with  the  Ito  definition 
of  the  stochastic  integral.  The  discussion  in  this  note 

applies  in  a  similar  way  to  any  of  the  many  suboptimal  filters 

whose  gain  and,  or  covariance  is  estimate  dependent. 


6 


In  practical  Implementation,  the  filter  equations  (3)  and  (4)  are 

discretized.  Usually  the  time  Increments  are  taken  to  be  small  enough 

* 

to  assure  acceptable  accuracy.  In  order  to  conform  with  ito's  defini¬ 
tion  of  stochastic  Integral,  the  system  matrices  F(x(t),t)  and  H(x(t),t) 
should  be  held  at  their  values  corresponding  to  the  beginning  of  each 
particular  Increment. 
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